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FOLLOWING EQUATION: Mz = Mzmox 


S3T22 


vMztmp < Mzmin 


Mztmp — 

\else 


Mz = Mzmin 
Mz = Mztmp 


S3T24 

S3126 53^28 





DETERMINE ANHPHASE ARM SWING ANGULAR ACCELERATION /3 a ACCORDING 
TO THE FOLLOWING EQUATION: a = jS aref + CMz-Mztmp) /A Ma 



S3130 



DETERMINE HORIZONTAL BODY ACCELERATION a REQUIRED TO GENERATE MODEL 
MANIPULATION aOOR REACHON FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED 
ZMP AT CURRENT TIME (TIME k) IF MOTION OF BODY TRANSLATIONAL MODE IS PERFORMED. 



DETERMINE aOOR REACHON FORCE HORIZONTAL COMPONENT Fx 
WHEN HORIZONTAL BODY ACCELERATION IS a . 



S3T32 



i3=0 

/? a = i8 aref 
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FIG.60 



INmAUZAT10N(t=0,ETC) 



S2010 



S2012 



oo 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL aCLEl.| ^201 4 



S2016 



yes 



IS GAIT 
CHANGING? 



I 



1 = 0 | S2018 



S2020 



READ NEXT TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT CYCLE, AND NEXT TIME GAIT CYCLE 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2022 



S2024 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOQTY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOQTY, 
AND INITIAL ANTIPHASE ARM SWING ANGLI/ANGUIAR VELOCITY) 



PROVISIONAUY DETERMINE GAIT PARAMETERS OF CURRENT TIME GAIT. 



S2026 



SUBROUTINE FOR CORRECHNG CURRENT TIME GAIT PARAMETERS 
(CORREa CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJEGORY OF NORMAL GAIT.) 



S2028 



S2030 



DETERMINE PARAMETERS OF FLOOR REACHON FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPUANCE CONTROL 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR REACTION 
FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS ZERO.) 



S2032 



S2034 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECIED GAIT 
(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 
FLOOR REAOION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 
ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP WHILE CORRECTING DESIRED ZMP 
AND ANTIPHASE ARM SWING RESTORING ANGUIM ACCELERATION PATTERN TO APPROXIMATE 
TO ORIGINAL GAIT AT THE SAME TIME.) 



t=t+At 
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FIG.61 



DETERMINE DESIRED FLOOR REAOION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2100 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 
THE BASIS OF GAIT PARAMETERS. 



S2102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2104 



CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITIONAELOOTY 
THAT SATISFY DESIRED FLOOR REACTION FORCE VERTICAL COMPONENT. 



S2106 



CALCULATE VERTICAL BODYPOSITION THATSATISRES 
TOTAL CENTER-OFGRAVITY VERTICAL PGSITIGN. 



S2108 



DETERMINE FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxmin,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2110 



DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 
RANGE [Mzmln,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2111 



DETERMINE FLOOR REACHON FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Mxymln,Mxymax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S2112 



S2114 



DETERMINE MODEL MANIPUUTION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REAOION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTiaL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZOHTAL ACCELERATION, BODY POSTURE INCUNATION 
ANGULAR ACCELERATION, AND ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACHON FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACHON FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISHED. 



S2116 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOaTY AND BODY POSTURE ANGULAR VELOCITY. 

FURTHER INTEGRATE THE RESULTTO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE 



S2118 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE ANTIPHASE ARM SWING ANGULAR 
VELOQTY. FURTHER INTEGRATE THE RESULT TO DETERMINE ANTIPHASE ARM SWING ANGLE. 
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c 



ENTRY 



3 



FIG.62 



DETERMINE DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BEIWEEN HORIZONTAL BODY POSITION OF 
CORRECIED GAIT AND HORIZONTAL BODY POSITION OF ORIGINAL GAIT. 



S2200 



DETERMINE DIFFERENCE IN BODY POSTURE INCUNATION ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN BODY POSTURE INCUNATION ANGLE OF CORRECTED 
GAIT AND BODY POSTURE INCUNATION ANGLE OF ORIGINAL GAIT. 



S2202 



DETERMINE DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BEIWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN ANTIPHASE ARM SWING ANGLE OF 
CORRECIED GAIT AND ANTIPHASE ARM SWING ANGLE OF ORIGINAL GAIT. 



S2204 



DETERMINE REQUIRED VALUE OF MODEL HORIZONTAL BODY POSITION STABIUZATION FLOOR 
REACnON FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS. 



S2206 



DETERMINE REQUIRED VALUE OF MODa BODY POSTURE INCUNATION ANGLE STABIUZATION 
FLOOR REACnON FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS 
OF DIFFERENCE IN BODY POSTURE INCUNATION ANGLE BEIWEEN MODELS. 



DETERMINE REQUIRED VALUE OF MODEL ANTIPHASE ARM SWING ANGLE STABIUZATION FLOOR 
REACnON FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN ANAPHASE ARM SWING ANGLE BEIWEEN MODELS. 



S2208 



S2210 



S22T2 



DETERMINE MODEL HORIZONTAL BODY POSITION STABIUZATION MOMENT, MODEL BODY POSTURE ANGlf 
STABIUZATION MOMENT, MODEL ANTIPHASE ARM SWING ANGLE STABIUZATION MOMENT, HORIZONTAL 
BODY ACCELERATION, BODY POSTURE ANGULAR VELOCITY, AND ANTIPHASE ARM SWING ANGUIAR 
ACCELERATION SUCH THAT THEY SATISFY RESTORING CONDITIONS. 



MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 
= MODEL HORIZONTAL BODY POSITION STABIUZATION MOMENT 
+ MODa BODY POSTURE ANGLE STABIUZATION MOMENT 



S2214 



DESIRED FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT FOR COMPUANCE CONTROL 
= COMPENSATING TOTAL aOOR REACHON FORCE MOMENT HORIZONTAL COMPONENT Mdmdxy 
+ MODEL MANIPUUTION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 



S2216 



DESIRED aOOR REACHON FORCE MOMENT VERTICAL COMPONENT FOR COMPUANCE CONTROL 
= COMPENSATING TOTAL aOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Mdmdz 

+ FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT BAUNCING WITH CORRECTED GAIT 



S2218 



( RETURN ^ 



Title: "CONTROLLER OF LEGGED MOBILE ROBOT' 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 53 of 74 

53/74 




Title: "CONTROLLER OF LEGGED MOBILE ROBOT' 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 54 of 74 



54/74 



FIG.64 

ZMP PERMISSIBLE RANGE 
(FLOOR REAQION FORCE CENTRAL 
POINT PERMISSIBLE RANGE) 
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DESIRED ZMP 



LEFT FOOT 
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RIGHT FOOT 
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FIG.65 
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INmAUZATION(t=0,ErC}| S3510 



S3512 



CO 



END 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL aaE). | S3514 



S3516 yes 



IS GAIT 
CHANGING? 



I 



1 = 0 I S3518 



S3520 



READ NEHTIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT aCLE, AND NEXT TIME GAITCYCLL 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S3522 



S3524 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOCITY, 
INITIAL BODY POSTURE ANGLE/ANGULAR VELOCITY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ANGULAR VELOCITY) 



PROVISIONALLY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S3526 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORREQ CURRENT TIME GAIT PARAMETERS SO THATTERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITIAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJEaORY OF NORMAL GAIT.) 



S3528 



S3530 



DETERMINE PARAMETERS OF aOOR REAOION FORCE HORIZONTAL COMPONENT 
PERMISSIBLE RANGE, FLOOR REACHON FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND FLOOR REACHON FORCE MOMENT 
VERTICAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORRECTION. 



S3532 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CURRENT TIME GAIT 
(DETERMINE IT SUCH THAT DESIRED ZMP IS SATISFIED, FLOOR REAOION FORCE MOMENT 
HORIZONTAL COMPONENT DOES NOT EXCEED FLOOR REAOION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE, AND ROOR REAOION FORCE MOMENT VERTICAL COMPONENT 
DOES NOT EXCEED FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE.) 



DETERMINE INSTANTANEOUS VALUES OF ZMP PERMISSIBLE RANGE, FLOOR REACHON 
FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE RANGE, AND FLOOR REACTION 
FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE FOR FULL-MODEL CORREOION. 



S3534 



GENERATE CORRECTED GAIT USING FULL MODEL | S3536 



t = t-!-At 
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FIG.67 
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SUPPORTING POINT 
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BODY MASS POINT 
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DESIRED ZMP VERTICAL POSITION 



FIG.68 

BODY POSTURE ANGLE CORREQING 
PERTURBATION MODEL 



INERTIAL MOMENT J 



FLYWHEEL 
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FIG.69 

ANTIPHASE ARM SWING ANGLE 
CORREOING PERTURBATION MODEL 
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FIG.77 



INITIAUZATION (t=0, ETC) 



S2310 



S2312 



oo 



WAIT FOR TIMER INTERRUPT (FOR EACH CONTROL aCLE). | ^2314 



S2316 yes 



IS GAIT 
CHANGING? 



I 



t = 0 I S2018 



S2320 



READ NEXT TIME GAIT'S SUPPORnNG LEG COORDINATE SYSTEM, 
NEXT BUT ONE TIME GAIT'S SUPPORTING LEG COORDINATE SYSTEM, 
CURRENT TIME GAIT aCLE, AND NEH TIME GAIT WCLt 



SUBROUTINE FOR DETERMINING GAIT 
PARAMETERS OF NORMAL GAIT 



S2322 



S2324 



SUBROUTINE FOR DETERMINING INITIAL STATES OF NORMAL GAIT 
(INITIAL DIVERGENT COMPONENT, INITIAL BODY POSITION/ VELOQTY, 
INITIAL BODY POSTURE ANGLE/ANGUIAR VELOOTY, AND INITIAL 
ANTIPHASE ARM SWING ANGLE/ANGULAR VELOaTY) 



PROVISIONALY DETERMINE GAIT PARAMETERS 
OF CURRENT TIME GAIT. 



S2326 



SUBROUTINE FOR CORRECTING CURRENT TIME GAIT PARAMETERS 
(CORREQ CURRENT TIME GAIT PARAMETERS SO THAT TERMINAL 
DIVERGENT COMPONENT OF CURRENT TIME GAIT AGREES WITH 
INITTAL DIVERGENT COMPONENT OF NORMAL TURNING GAIT AND 
THAT ANTIPHASE ARM SWING ANGLE CONVERGES TO ANTIPHASE 
ARM SWING ANGLE TRAJEQORY OF NORMAL GAIT.) 



S2328 



S2330 



DETERMINE PARAMETERS OF FLOOR REACTION FORCE MOMENT HORIZONTAL 
COMPONENT PERMISSIBLE RANGE FOR COMPUANCE CONTROL 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF ORIGINAL GAIT 
(DETERMINE INSTANTANEOUS VALUE OF ORIGINAL GAIT SUCH THAT FLOOR 
REACnON FORCE MOMENT HORIZONTAL COMPONENT ABOUT DESIRED ZMP IS 0.) 



S2332 



S2334 



SUBROUTINE FOR DETERMINING INSTANTANEOUS VALUE OF CORRECTED GAIT 

(DETERMINE INSTANTANEOUS VALUE OF CORRECTED GAIT SUCH THAT MODEL MANIPULATION 

FLOOR REACTION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) IS 

ADDITIONALLY GENERATED ABOUT CORRECTED DESIRED ZMP, WHILE CORREOING DESIRED ZMP 

AND ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN SO AS TO 

APPROXIMATETO ORIGINAL GAIT AT THE SAME TIME. HOWEVER, FLOOR REACTION 

FORCE PERMISSIBLE RANGE IS CHANGED ACCORDING TO RESULT OF SUPPAGE DETERMINATION.) 



t = t+ At 



1 S2336 
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FIG.78 



DETERMINE DESIRED FLOOR REAOION FORCE VERTICAL 
COMPONENT AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5100 



DETERMINE DESIRED ZMP AT CURRENT TIME ON 

THE BASIS OF GAIT PARAMETERS. 



S5102 



DETERMINE DESIRED POSITIONS/POSTURES OF BOTH FEET, REFERENCE BODY POSTURE 
AND REFERENCE ARM POSTURE AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5104 



CALCULATE TOTAL CENTER-OF-GRAVITY VEIOKAL POSITIONAELOOTY 
THAT SATISFY DESIRED FLOOR REACnON FORCE VERTICAL COMPONENT. 



S5106 



CALCULATE VERTICAL BODY POSITION THAT SATISHES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION. 



S5108 



DETERMINE FLOOR REACHON FORCE HORIZONTAL COMPONENT PERMISSIBLE 
RANGE [Fxinin,Fxmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 
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DETERMINE FLOOR REACTION FORCE MOMENT VERTICAL COMPONENT PERMISSIBLE 

RANGE [Mzniin,Mzmax] AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



DETERMINE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE rMxvmin MxvmaxI AT CURRENT TIME ON THE BASIS OF GAIT PARAMETERS. 



S5112 
S5114 



S5116 



yes 



S5118 



RESULT OF SUPPAGE 
DETERMINATION 
= IS THERE SUPPAGE?\no 



GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUQNG RATE att TO 0. 



$5120 



GRADUALLY APPROXIMATE PERMISSIBLE RANGE REDUCING RATE oH TO T. 1 



MULTIPLY Fxmin, Fxmax, Mzmin, AND Mzmax BY REDUQNG RATE ott SO AS TO NARROW 
FLOOR REACTION FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE AND FLOOR 
REACnON FORCE MOMENT HORIZONTAL COMPONENT PERMISSIBLE RANGE. 



S5122 
S5124 



DETERMINE MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT, 
DESIRED FLOOR REAOION FORCE MOMENT (HORIZONTAL COMPONENT AND VERTICAL COMPONENT) 
FOR COMPLIANCE CONTROL, BODY HORIZONTAL ACCOERATION, BODY POSTURE INCUNATION 
ANGUUR ACCELERATION, AND ANTIPHASE ARM SWING ANGULAR ACCELERATION SUCH THAT 
CONDITIONS OF FLOOR REACTION FORS MOMENT HORIZONTAL COMPONENT PERMISSIBLE 
RANGE, FLOOR REACTION FORCE MOMENT VERTIUL COMPONENT PERMISSIBLE RANGE, 
AND FLOOR REACHON FORCE HORIZONTAL COMPONENT PERMISSIBLE RANGE ARE SATISRED. 



INTEGRATE HORIZONTAL BODY ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION TO 

CALCULATE HORIZONTAL BODY VELOCITY AND BODY POSTURE ANGULAR VELOaiY. 

FURTHER INTEGRATE THE RESULT TO DETERMINE HORIZONTAL BODY POSITION AND BODY POSTURE. 



INTEGRATE ANTIPHASE ARM SWING ACCELERATION TO CALCULATE HORIZONTAL BODY VaOOTY 
AND ANTIPHASE ARM SWING ANGULAR VELOCITY. FURTHER INTEGRATE THE RESULT TO 
DETERMINE ANTIPHASE ARM SWING ANGLE. 
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FIG.79 
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SPIN DETERMINING SUBROUTINE 
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TRANSLATIONAL SLIPPAGE DETERMINING SUBROUTINE 



S5212 



SLIPPAGE VIBRATION DETERMINING SUBROUTINE 
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S5216 



yes 
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DOES DETERMINATION 
RESULT INDICATE 
PRESENCE OF 
SPIN OR SKID OR 
SLIPPAGE VIBRATiON?\no 




SLIPPAGE DETERMINATION RESULT = SLIPPAGE 



S5220 



SLIPPAGE DETERMINATION RESULT = NO SLIPPAGE 
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FIG.80 
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DETERMINE GROUND ANGULAR VELOCITY VERTICAL COMPONENT ojsupz OF 
FOOT OF THE SUPPORTING LEG ON THE BASIS OF AQUAL BODY POSTURE 
ANGULAR VELOCITY AND JOINT ANGLE COMMAND (DETECTION VALUE). 



S5310 



DETERMINE CHANGING RATE dMsupactz/dt OF SUPPORTING LEG FLOOR 
REAQION FORCE MOMENT VERTICAL COMPONENT. 



S5312 



S5314 



yes 



I cusupz I >a)e?y 



DETERMINE APPARENT TWIST SPRING CONSTANT Ksupt 
OF SUPPORTING LEG (=(-dMsupactz/dt)/£osupz). 



S5318 



Ksupt<Ksuptmin? 




S5316 
S5320 



SPIN DETERMINATION RESULT = SPIN 
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SPIN DETERMINATION RESULT = NO SPIN 



SPIN DETERMINATION RESULT = NO SPIN 



S5324 
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FIG.81 
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S5410 

DETERMINE GROUND TRANSLATIONAL VELOCITY HORIZONTAL COMPONENT Vsupxy OF 
FOOT OF THE SUPPORTING LEG ON THE BASIS OF AQUAL BODY POSTURE ANGUIAR VELOCITY, 
DETEQION VALUE OF ACCELERATION, AND JOINT ANGLE COMMAND (DETECTION VALUE). 
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